#include "inc/hw_types.h"		// tBoolean
#include "inc/hw_memmap.h"
#include "utils/uartstdio.h"	// input/output over UART

#include "driverlib/pwm.h"
#include "driverlib/gpio.h"
#include "driverlib/sysctl.h"

#include "RobzDemo.h"

#include "RASLib/timer.h"
#include "RASLib/motor.h"
#include "RASLib/encoder.h"
void testInit(void) {
	InitializeEncoders(true, false);
	InitializeMotors(true, false);
}

void test(void) {
	
	encoder_count_t encoder0 = 0, encoder1 = 0;
	
	PresetEncoderCounts(0, 0);
	
	GetEncoderCounts(&encoder0, &encoder1);
	UARTprintf("enc0:%d  enc1:%d      \n",encoder0,encoder1);
		
	SetMotorPowers(127, 127);
	Wait(1000);
	SetMotorPowers(0, 0);

	GetEncoderCounts(&encoder0, &encoder1);
	UARTprintf("enc0:%d  enc1:%d      \n",encoder0,encoder1);
}
